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An intrinsic Cramer-Rao bound on SO(3) for (dynamic) attitude 

filtering 


Silvere Bonnabel and Axel Barrau 


Abstract —In this note an intrinsic version of the Cramer- 
Rao bound on estimation accuracy is established on the Special 
Orthogonal group 50(3). It is intrinsic in the sense that it 
does not rely on a specific choice of coordinates on 50(3): 
the result is derived using rotation matrices, but remains valid 
when using other parameterizations, such as quaternions. For 
any estimator R of R e 50(3) we give indeed a lower bound on 
the covariance matrix of log ( RR T ), that is, the estimation error 
expressed in terms of group multiplication, whereas the usual 
estimation error (k — R) is meaningless on 50(3). The result 
is first applied to Whaba’s problem. Then, we consider the 
problem of a continuous-time nonlinear deterministic system on 
50(3) with discrete measurements subject to additive isotropic 
Gaussian noise, and we derive a lower bound to the estimation 
error covariance matrix. We prove the intrinsic Cramer-Rao 
bound coincides with the covariance matrix returned by the 
Invariant EKF, and thus can be computed online. This is in 
sharp contrast with the general case, where the bound can 
only be computed if the true trajectory of the system is known. 

I. Introduction 

We consider the problem of attitude estimation from vector 
measurements, where the attitude parameter is static in the 
first place, and then the dynamic case where it evolves 
on the special orthogonal group SO(3). Attitude estimation, 
both in the static and dynamic cases, has been the subject 
of numerous works due to its potential applications to e.g. 
aerial vehicles (or satellites) control. The references are too 
numerous to be exhaustively listed, and the reader is referred 
to e.g. [19] for an overview of estimation problems on SO(3), 
or the survey [16], and e.g. the paper [18] for a very recent 
work on the subject. 

In the present paper an intrinsic version of the Cramer- 
Rao bound on estimation accuracy is established in Section 
HIl on the Special Orthogonal group 5(9(3). It is intrinsic 
in the sense that it does not rely on a specific choice of 
coordinates on 5(9(3). For any estimator R of R £ 5(9(3) we 
give a lower bound on the covariance matrix of log (RR t ), 
that is, the estimation error expressed in terms of group 
multiplication, and then projected onto a three dimensional 
vector space using the logarithmic map of 5(9(3). This error 
indeed makes sense as RR T is the rotation that maps the 
estimated orientation to the true orientation, whereas the 
usual estimation error (R~R) is meaningless on 5(9(3), 
as (R — R) is not a rotation matrix, and has no intrinsic 
counterpart. Taking advantage of the Lie group structure 
of the space the calculations are rather simple and direct. 
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Viewing 5(9(3) as a manifold and choosing an invariant 
metric, we recover in a simple way the result derived by 
S. Smith in [23] (see also the recent work of N. Boumal 
[12], [13]). 

As a straightforward application, the result is first applied 
to the static attitude estimation problem, also known as 
Whaba’s problem [26], for which we derive a lower bound. 
Note a (classical) Cramer-Rao lower bound has already 
been proposed in [15] for the linearized problem. Then, 
we consider in Section [III] the problem of attitude estima¬ 
tion/filtering from vector measurements and angular velocity 
measurements from a gyroscope (see e.g. [18], [20] and 
[17] for an implementation) in the degenerate case where 
the gyroscope is of much higher quality than the other 
sensors. For systems possessing deterministic dynamics and 
stochastic output measurements, J. H. Taylor proved in [24] 
the Cramer-Rao bound is provided by the Extended Kalman 
Filter (EKF) covariance, linearized around the true unknown 
trajectory of the system, and thus cannot be computed online. 
Thanks to the invariance properties of the system, we prove 
the Cramer-Rao bound does not depend on the true system’s 
trajectory, and can be computed online. 

The Invariant Extended Kalman Filter (IEKF) is a recent 
methodology to modify the EKF in order to account for the 
invariance properties of the state space when devising EKFs 
on Lie groups, see [10], [9], and more recently [5] where an 
IEKF is derived on 5(9(3) with discrete time observations. 
A remarkable property of the IEKF, akin to the properties of 
symmetry-preserving observers [7], [8] from which the IEKF 
is derived, is that the estimation error system depends on the 
system’s trajectory in a reduced manner, and sometimes does 
not depend on it at all, a property shared by the intrinsic 
Cramer-Rao bound derived in this paper. In fact, the links 
between both theories go beyond: in the case considered here 
on 5(9(3), we prove in Section HVl the intrinsic Cramer-Rao 
bound coincides with the covariance matrix returned by the 
Invariant EKF (and thus can be computed online). 

II. An intrinsic Cramer-Rao bound on SO(3) 

A. The classical Cramer-Rao bound 

Consider a family of probability densities p(x\ 9) param¬ 
eterized by a vector 6 £ R*. Consider an unbiased estimator 
0(x) of the parameter 0 from a sample measurement x. The 
requirement that 6 be unbiased means it must be “good” (for 
a large sample) whatever 9. Because of this requirement, the 
estimator can not recover 9 exactly, given a single or a finite 
number of measurements. This fact is formalized by the well- 
known existence of a lower bound on the accuracy of the 


estimator: the so-called Cramer-Rao bound. Mathematically, 
it states the average estimation error covariance is lower 
bounded as follows 

P:=E e ((0-0)(0-0) r ) hJ- 1 

where Eg denotes the expectation with respect to the prob¬ 
ability law p(x | 0), and the matrix J (the inequality is 
in the sense of the Loewner order) is the so-called Fisher 
information matrix, defined as the Hessian with respect to 0 
of the average log likelihood Eq (In (p (x | 0))), where ln(.) 
denotes the natural logatithm of R + . 

The interesting question raised by S.T. Smith [23], is 
whether there exists an analogue of this bound for a pa¬ 
rameter 0 that belongs to a Riemannian manifold, and not 
a vector space anymore. This kind of question can arise in 
signal processing, where one seeks to estimate for instance 
a subspace, as in Principal Component Analysis, that is, an 
element of the Grassman manifold. To answer this question, 
one must first find a way to compare the estimator 0 and 
the true parameter 0 , as on a manifold the quantity 0 — 0 
has no meaning. This can be done through the Riemann 
exponential map, and then, [23] proves a Cramer-Rao bound 
can be produced. Adapting the classical proof to the manifold 
case, he shows that the (well-defined) error covariance P 
is lower bounded by a (well-defined) information matrix 
J, plus additional terms steming from the curvature of the 
parameter space. Unfortunately, the formula is not in closed 
form. However, for sufficiently small covariance P it can be 
expanded up to terms of order (9(P 3 / 2 ). 

The quite inspiring paper [23] draws new links between 
statistics and geometry. It has been in particular adapted to 
the quotient manifold case in [12], In the present paper, we 
derive similar results for the SO(3) case, more simply, and 
we apply them to two attitude estimation problems. Note that, 
a tutorial presentation on the intrinsic Cramer-Rao bound can 
be found in e.g. [4]. 

B. Direct derivation of the Cramer-Rao bound on .S’(9(3) 

We compute here the Intrinsic Cramer-Rao Lower Bound 
(ICRLB) on SO(3), up to the second order terms in the 
estimation error d(R,R ) where d denotes the bi-invariant 
distance on 5(9(3). This allows to recover in a simple and 
direct way the result of [23] taking advantage of the Lie 
group structure of the parameter space (and thus without 
having to evaluate Riemann’s curvature tensor at R). 

1) Preliminaries: 5(9(3 ) is a Lie group of dimension 3, 
and thus a Riemannian manifold. The tangent space at Id, 
the Identity rotation, denoted 00 ( 3 ) is called the Lie Algebra 
of 5(9(3) and can be identified with R 3 that is 

00 ( 3 )« R 3 

Using rotation matrices (i.e. viewing 5(9(3) as a submanifold 
of R 3x3 ) the (group) exponential map defined by 

exp : 00 ( 3 ) i-)- 5(9(3) 
exp(£) = expm[(£) x ] 


where expm denotes the matrix exponential map, and where 
(a) x € R 3x3 for a G R 3 denotes the skew symmetric matrix 
defined by (a) x u = a x u, Mu G R 3 . In a neighborhood of Id, 
the exponential map can be inverted. The (group) logarithmic 
map 

log : 5(9(3) i->- 00 ( 3 ) 

is defined as the inverse of exp. For any estimator R of a 
parameter/? G 5(9(3), it allows to measure the mean quadratic 
estimation error 

E« (| I log {RR T ) I ^3) =E R (d(R,R) 2 ) 

The logarithmic map allows also to define a covariance 
matrix of the (right-invariant) estimation error 

P = E fi (log (RR t ) log (RR t ) T ^ g R 3x3 (1) 

and we have as usual E^ (</ (/?,/?)^ = Tr(P). 

Note that, if R and R denote orientations of bodies in 
space, the quantity log ( RR T ) G R 3 has an intrinsic purely 
geometrical interpretation as its orientation denotes the axis 
of rotation and its norm the rotation time around which 
the body with configuration R must rotate in order to reach 
configuration R, and provides us with a natural orientation 
error in R 3 . 

2) Main result: Consider the family of densities parame¬ 
terized by an element R of SO(3) 

p(X |k),ZG.//, R G 5(9(3) 


where the sample space ..fiC is a measurable space. To fix 
ideas we will consider in the sequel that ./// is R 9 for 
q G N, as will be the case in the examples. Using the 
exponential map, and mimicking its Riemannian analogue 
[23], we introduce 

Definition 1: The intrinsic Fisher information matrix can 
be defined in a right-invariant basis as follows for any t, G R 3 




\np{X |exp(f|)/?) 


(=0 


(=0 


\np (X | exp(f|)/?) ] p(X\R)dX (2) 


and then J(R) can be recovered using the standard polariza¬ 
tion formulas: 


Z Tj v = \ ((§ + v ) Tj (5 + v) - £, T J^ - v t jv) . 

Besides, note that, using the fact that 


j P (X I exp(t^)R)^lnp(X \ exp(t£)R)dX 

= j t Jp{X\ex V (t$)R)dX=Q (3) 

and differentiating the latter equality w.r.t 1 then reusing that 

TtP = Pi lo SP we have 

/ (jrt lnp ( x i exp ^^^) (jjt^ np ( x 1 ex p(^)^)) dx 

+ JP {X | exp {t£)R) In/? (X \ exp (t%)R)dX = 0 




allowing to recover an intrinsic version of the classical 
result according to which the information matrix can be also 
defined using a second order derivative (i.e. a Hessian). 

Proposition 1: The intrinsic Fisher information matrix 
also writes 


Z T J(RK = - e s 


d 2 

dt 2 


In p(X | exp (t$)R] 


t =o 


Let R be an unbiased estimator of R in the sense of centered 
intrinsic (right invariant) error RR T , that is, 


J log [RR t (X)] p(X\R)dX = 0. 


Theorem 1: Let P be the covariance matrix of the estima¬ 
tion error as defined in 0. We have then 

PhJ(R)- 1 -^(Tr(P)I 3 -P)J(R)- 1 

12 (4) 

-- J(R)- l (Tr(P)I 3 -P) 

where we have neglected terms of order 
E/t (\\\og[RR T (A r )]|| 3 ). For small errors, we can neglect the 
terms in P on the right hand side (curvature terms) yielding 

P = j log ( RR(X) t ) log (rR(X) t Y p(X \R)dX 
> J(R)~ l + C, 

where C are terms of higher order, linked to the effect of the 
curvature of the parameter space 5(9(3), hence the letter C, 
which here stands for “curvature terms”. 


C. Application to Waliba ’s problem 

Before proving the results let us give an example applica¬ 
tion. In this subsection we assume measurements are of the 
form 

X k = R r d k + V k , 


where dfs are some reference vector in R 3 , and where 
Vjt’s are independent isotropic and Gaussian noises with 
covariance matrices opld. This implies the following density 
form 

-In p(X k | R) = \\X-R T d k \\~. 

2a k 


Wahba’s problem consists in finding the maximum likeli¬ 
hood estimator of R and has been solved using a Singular 
Value Decomposition. We now give a lower bound on the 
estimation accuracy. Let R be an unbiased estimator of R 
in the sense of the intrinsic (right invariant) error RR r . 
After n measurements, the information matrix is (using the 
independence of the noises) 

t, T Jn{R)£, =-E E « {jjfl ln P( x k | exp (t%)R) 


To derive J we first note that: 

| \X k -R t exp (-f§)4|| 2 = P*|| 2 -2 d\ exp (t$)RX k + \\d k \| 2 


We have besides the following Taylor expansion 

expm((f|) x ) =I + t(£) x + Y 2 (Z) 2 x +0(t 3 ) (5) 

so the second derivative at t = 0 of | \X k — R T exp (— 1 4) d k 11" 
is —d k [£,) 2 x RX k . As we have E« (RX k ) = d k we obtain: 

E r ( -d\)\RX ) = -d T k (£)\d k = 


Let Hi = (<4)x, we have proved the following relation: 


Efl 


dr 
dt 2 


In p{X k | exp(f^)/?)) 


t=o 



giving immediatly: 

Proposition 2: For Wahba’s problem [26], the intrinsic 
covariance matrix defined by ([T]) where R is any unbiased 
estimator for a sample of n independent measurements, 
satisfies inequality Q where 


J(R) = L^2 H I H k . 

1 a k 

Note that, the result does not depend on the underlying 
parameter R. This might be explained using theory of equiv- 
ariant estimators on Lie groups that can be traced back to 
[ 22 ], [ 21 ] (see also [ 6 ] for a more recent exposure). 


I). Proof of the result 0 

Let R be an unbiased estimator of R in the sense of the 
intrinsic (right invariant) error RR T , that is, 

J log [RR t (X )] p {X | R)dX = 0 . 

So, if we let % be any vector of the Lie algebra and t € R, 
differentiating the latter equality we get 

Y j x ] ° g [ ex P(^)^ r ( X )]p(X \e*p(t£)R)dX =0. 

Formally, this implies 

Dlog(RR T (X)) [(t;) x RR T (X)]p(X\R) 

N , (6) 

+ log (RR t (X))D 2P (X | R) [^) x R]jdX = 0 

where D denotes the differential and /Ji the partial differ¬ 
ential with respect to the second argument. For any vector 
u G Q we have thus: 

-J x (u,Dlog(RR T (X)) [(^) x RR T (X)])p(X\R)dX 
= j (u, log (RR T (X)))D 2 p(X | /?)[(§ ) X R\dX 

^ YJ x ( u ^g{RR T (X))) 2 p(X\R)dX ■ 

Yj x (D 2 lnp(X \RM) X R}) 2 p(X\R)dX 

where we used the Cauchy Schwarz inequality and the 
relationships 

D 2 p = pD 2 log p. and then p = 








We introduce a basis of g and the matrix A (X) = 
log (RR(X) t ). The latter inequality can be re-written as 
follows: 


^ u 


u T j x D\og(RR T {X)) [£) x RR T (X)\p{X\R)dX 

J A(X) T A(X)p(X\R)dX u^J E, T J(R)E, (7) 


Now we compute a second-order expansion of the left-hand 
term in the estimation error Q := RR r (X). To do so, we 
note log[exp [tE,)Q] = log[exp(f^)exp(log(g))] is equal to 
(using the Baker-Campbell-Hausdorff formula and keeping 
only terms up to f 2 ) 

4 - 5«4>g+ p7 flfif iog(e)^ + c, (ll 1 °g(G)ll 3 )]^ 


Differentiating w.r.t to t yields 


D\ 0 g{Q)[£) x Q] 


~ad log ( Q ) + —ad, 


1 

12 

+ D(||log(G)|| 3 ) 


2 

iog(e) 


Neglecting the third-order terms we get: 


D\og{QM) x Q\ = 


(Q))> 


l 

12 


(log(G))> 


« = 


1 


I- ^(log(G))x + (log(01og(e) r - ||log(0)|| 2 / 3 ) 


We introduce the latter second-order expansion in the error in 
the equation ([7} (note this is only formal as the second-order 
expansion will appear in an integral): 


This inequality is true for any u, Ef, which implies matricially 
the following desired result: 


P>- 



Tr{P) 

12 


h 


12 





Tr(P) 


12 


7 3 H- P 

3 12 


( 8 ) 


E. Links with the Cramer-Rao bound on manifolds [23] 
The main result of [23] stipulates that: 

P+ ] -[R m (P)J-' +J~ 1 R m (P)) - l -R m (P)J~ l R m (P)] f J- 1 

(9) 

where R m (P) is defined through Riemann’s curvature tensor, 
and making use of the bi-invariance of the right-invariant 
metric of 5(9(3) (see e.g. [2] for Riemann’s sectional curva¬ 
ture formulas on Lie groups) it boils down to (R m (P)u,u) = 
E(ill« x log(R r R(X))|| 2 ) = -~\u T E((log[R T R(X)}) 2 x )u = 
~\ l,T [P~Tr(P)\u. Replacing in © we get: 

P-^{[P- T r(P)h\ J - 1 +r l [P-Tr{P)l 3 ]) 

- P - Tr(P)I 3 ]J~ l [P - Tr{P)h] X J - 1 

The same formula is obtained developing ([8]). which proves 
both results coincide. However, the reader can check that 
the calculation on a general Riemannian manifold is more te¬ 
dious (and local). The Lie group case is more straithtforward 
and the results are obtained without using the machinery of 
Riemannian second-order geometry. 

III. Application to dynamic attitude filtering 


u T [ 

Jx 


I- l -(\ 0 g(RR(X) T )) x + ^{\og(RR{X) T \og(RR{X) T 


-i 2 


||log(RR(X) J )||-/ 3 ) p(X\R)dXS 


We now consider the following system 


—R t =R,{co{t)) x , 

dt 




( 10 ) 


< u 


u)(t; T J(R)ti) 


[ A{X) T A{X)p(X\R)dX 
Jx 

This writes using the fact that R is unbiased (which makes 
the term in front of the factor 7 cancel as (log((9)) = 0) 

+ j x [A(X)A(X) T - T r(A(X)A(X) T )I 3 }p(X\R)dX^} 2 

u) ^ T J{R)i) 


< U 


[ A(X) T A(X)p(X\R)dX 
Jx 


Letting P = f x A(X)A(X) T p(X\R)dX we get: 

-i 2 


l-fjr(P) 




S [u !'u)[q .Iqi 


The change of variables = [[l — j^Tr(P)\ f + j^P) ^ 
yields: 


<(«'/>«) - U 


/T 


i-- 2 Mp) 


h + - 2 P 


1- Ti MP) 


h + - 2 P 




that is, the motion in space of a solid fixed at a point, 
having deterministic known angular velocity ©(f), and noisy 
measurements at discrete times t\ < t 2 < • ■ •. This fits into the 
general filtering setting of [24]. We assume that V® and Vj 
are Gaussian noises with covariance matrices (<r°)“ Id and 
(<7,J Id. Our goal is to derive an intrinsic lower Cramer- 
Rao bound on the estimation error. We will see it follows 
from the results of Section HI1 indeed, thanks to the facts that 
1 - R t is a deterministic quantity and 2- due to the invariance 
of the system, the flow can be explicitly computed. 

Such problems arise for attitude estimation in the degen¬ 
erate case where the gyroscope is infinitely better than the 
vector sensors. Sensors measuring in the body frame vectors 
from the fixed frame include magnetometers, that measure 
the earth magnetic field in the body frame, and accelerome¬ 
ters, that measure the earth gravity vector field in the body 
frame, under static flight assumptions. For each of these 
sensors, the isotropy assumption of the noise is reasonable 
technologically, as the measurements are performed using in 
each case three orthogonal one-axis sensors (accelerometers 
or magnetometers). The Gaussianity is more questionable but 
it is a convenient and widespread assumption about the noise. 


































A. Intrinsic Fisher information matrix computation 

The conditional intrinsic information matrix at time n is 
(using [24] and the results above) 

Z T Jn% =~E R (^lnp(Y u ... ,Y n |exp(f£)R,J^ . 

Now, using the invariance of the dynamics, we see there 
exists a rotation A{k 1 n) depending only on co(s), 4 < s < 
t n such that R tn = R tk A(k,n). Indeed A(kji) is the solution 
at time t n to the differential equation on SO(3) defined by 
jpA s =A s co(s) 1 A tk = Rr k (see eg. [5]). As a result, all the 
measurements are independent given R tll and we can write: 


-InpOV-- ,Y n | exp (t£)R, n ) 

= - Ein p(Y k | exp (t£)R t „A(k,n) T ) 
k= 1 

=Cst + £ -K 11 Y ° ~ A (, k,n)Rf n exp (-t£ )d° k \ \ 2 
k= 1 Za k 

+ E 11 Y k - A X n ) R l ex P(- f 4K 1 11" 

k= 1 /C7 A 


When deriving an intrinsic Cramer-Rao bound for Wahba’s 
problem in Section [III we have already proved that letting 
H = ( d) x we have for any Q £ SO( 3) such that E (QY) = d 
that 

^E (j|F-g r exp(-^)d|| 2 ) = -2^E(d T Qexp(-t^)Y) 

= 2 B, t HH t ^ 

( 11 ) 

and the result does not depend on Q. Differentiating 
— lnp(Yi,-" ,F„ | exp (t£)R t „) twice w.r.t. 1 and using (ITTb 
with Q = R tll A(k,n) T (which is valid as E r, {QYf) = 
E R, k ( R tll A(k,n) T Y ‘) = E R , k (R, k Y‘) = d[ for i = 1,2), we get 
finally: 




,Y n \R tl ,--- ,exp (t£)R, n ) 



uO T tjO 

2 H k H k - 


XI) 


> Hl T Hl 


B. Intrinsic Cramer-Rao bound 


A mere application of Theorem 1 implies 
Proposition 3: For the considered system (ITOb . at time t„, 
the accuracy P = E(\og(R tn Rj )log (R tn Rj) r ) of any unbiased 
attitude estimator is lower bounded according to formula (Q]), 


with m=n=i 


W) 




IV. Links with Invariant Kalman filtering 

For the filtering problem of Section [Till on can derive an 
Invariant Extended Kalman Filter (IEKF) [10]. The IEKF 
is a novel methodology for devising EKFs on Lie groups, 
where the EKF is bound to respect the invariances of the 
problem, and where an intrinsic estimation error is linearized 
at each step. Moreover, the exponential map allows to map 
the Kalman correction term to the state space. The IEKF 


for the problem above is derived on SO(3) in the recent 
paper [5], and we briefly recall the principle here. The IEKF 
equations write 

d 


dt 


R,=R t (co(t)) > 


t n -\ <t<t n 


(Propagation) (12) 


R7 = exp K„ 


Kjn-dl 
RtX ~d\ 


Rt„ j i — hi 


(Update) 

(13) 


where K n £ R 3x3 is the gain matrix to be tuned as follows. 
Letting t,, = log (R, R j) be the right invariant estimation 
error projected in the Lie algebra, the error system has the 
following remarkable autonomous form 




tn— 1 ^ tn 


(Propagation) 


expfe„r = exp (*. (^|;g : % % $) ) exp(5„) 

( Update) 

During the propagation step, the covariance of the linearized 
estimation error P, = E (^tX) remains fixed, that is, 

X + 1 =K 

as the linearized dynamics (for the well-chosen estimation 
error) yields a static system and it was assumed there is no 
process noise. As concerns the update step, using formula 
©. a first order approximation to the error update equation 
above reads [5] 


X ~ + K„ 

= (h-Kn 


%t n x d\ + V,} 


K n 


The gain that minimizes the increase in the covariance matrix 
of the linearized error at the update step is the Kalman gain 

\ -l 


Kn = P, 



with N = 
update: 


(cT,?) 2 / 3 

0 3 


0 3 


h j 


+ N 


leading to the covariance 


0 KX= p X + 


H 


H 


H, 


Hi 


(XY (°,ir 

As there is no a priori information about the value of R tl , a 
usual way to initialize the filter is maximum likelihood: 

,2 


R, t = min 


in{||RF 1 °-J?|| 2 /((7 1 0 ) 2 +| 


IRF/ -d\ I 


'/M) 2 } 


(14) 

As concerns the covariance matrix P\ = Cov (4, ), where 
exp(^j) = R tj Rl r a first-order expansion of ( 1 1 4| i reads 
Zn = min||£ fl xd° + V„°|| 2 + \\B, h xd\+V^\ 


i.e. 


KM.KfM 

“wr + wr 


H?V?+H! V, 


'1 V 1 


h/D 


ri 


6 , = 
which gives: 










(P ti y l = Cov^y 1 = Gathering 

K) K) 

the previous results we obtain: 

Proposition 4: The covariance matrix of the error returned 
by the IEKF writes 


P„ = 


H k ''k j r ’Y^ H k H k 


U= 1 


WY 


k= 1 


( ) 


and thus the IEKF returns the Cramer-Rao bound for the 
associated filtering problem, neglecting the curvature terms. 

Note that, it is logical that the curvature terms be ignored 
by the IEKF as it is based on a first order approximation of 
the estimation error. The result is in sharp contrast with the 
general theory [24] that stipulates that the Cramer-Rao bound 
is the EKF covariance indeed, but, linearized around the true 
trajectory, that is unknown to the user. Those bounds are 
referred to as “posterior Cramer-Rao bounds’' in the filtering 
and hidden Markov models (HMM) literature (see e.g. [25]). 
For invariant systems on SO(3), in the case of deterministic 
dynamics, we have proved the bound can be computed in 
real time. This appears as another remarkable feature of 
dynamical systems defined on Lie groups. 


V. Conclusion 

In this paper we have derived an intrinsic Cramer-Rao 
lower bound (ICRLB) on 5(9(3) in a straightforward way. 
We have applied it to derive an ICRLB for Wahba’s problem 
when the noise is isotropic and Gaussian. Then, we have also 
derived an ICRLB for the problem of filtering on 5(9(3) 
a system with deterministic evolution and noisy isotropic 
Gaussian measurements. We have also proved the intrinsic 
CRLB is the covariance matrix returned by the invariant 
EKF on 5(9(3). This is a remarkable result, as generally the 
CRLB can not be computed online as it presupposes to know 
the true trajectory of the system, which is precisely what 
one seeks to estimate. It is thus usually reserved for offline 
simulations to test filters’ efficiency, and we generally speak 
of “posterior Cramer-Rao bounds” [25], 

In the future, we would like to investigate in what ways 
the intrinsic gradient methods (see [11], [1]) might asymp¬ 
totically reach the Intrinsic Cramer-Rao bound. Besides, we 
hope it is possible to derive an ICRLB for the filtering 
problem considered in the present paper, but with a noisy 
evolution (that is, using noisy gyroscopes). In this case it will 
certainly not coincide with the covariance returned by the 
IEKF, but it might be computable online taking advantage of 
the invariances of the system. Such results could be applied 
to a wide range of aeronautics estimation problems, like 
e.g., [3], and may be useful to test efficiency of some other 
instrinsic filtering methods, such as [14]. 
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